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5 Control system, method and computer program for synchronizing 
several robots 

TECHNICAL FIELD OF THE INVENTION 

10 The present invention concerns a control system for controlling 
the movements of a plurality of mechanical units, namely robots 
and external axes, such as workstations or transport tracks. 

The present invention also concerns a method for controlling a 
15 plurality of mechanical units and a computer program containing 
computer program code means for making a computer or 
processor execute the steps of such a method. 

PRIOR ART 

20 

An industrial robot includes a manipulator and a control system 
having means for operating the manipulator. The control system 
comprises a storage unit for storing one or more control 
programs for controlling the movement of the manipulator. The 

25 control program comprises program instructions, including 
movement instructions for the manipulator. The control system 
further comprises a program executer for executing the control 
programs and to provide instructions based on said movement 
instructions, and a path planner adapted to receive said 

30 instructions from the program executer and on basis thereof 
determine how the manipulator should move in order to be able 
to execute the movement instructions. The path planner plans 
how the instructed movement should be performed by carrying 
out an interpolation of the movement. The interpolation includes 

35 dividing the instructed movement into a plurality of small 
increments, and computing the joint angles for all axis of the 
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robot for each increment. The joint angels are then converted 
into motor references. The path planner transmits the computed 
motor references to one or more drive modules, such as 
servomechanisms, to drive the manipulator in accordance with 
5 the movement instructions. 

Many industrial plants utilize systems comprising a plurality of 
mechanical units, such as a multiple robot system or a system 
comprising one robot that cooperates with one or more external 
10 axes. In many applications it is a desire that the mechanical 
units perform mutually coordinated, i.e. synchronous 
movements. 

For this purpose it is known to have a single general control 
15 program for controlling the mechanical units to perform 
synchronous movements. The single general control program 
comprises program instructions, including movement 
instructions for all of the mechanical units. The mechanical units 
are connected to a control system comprising a program 
20 executer for executing the single general control program, and a 
path planner for determining how the mechanical units should 
move in order to be able to execute the movement instructions 
of the control program. 

25 European patent application nr 89309635.4 discloses a robot 
control system for controlling a set of industrial robots for 
coordinated, cooperative operation in accordance with a single 
general control program. The single general control program 
comprises movement instructions for the set of industrial robots. 

30 The control system comprises a single reading/compiling unit for 
separately reading the movement instructions from the storage 
unit and extracting the movement instructions for each industrial 
robot. 

35 When running such a program for multiple mechanical units it is 
however sometimes necessary to interrupt the program and 
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move, or jog, one robot independently of the other robots in 
order to perform maintenance or repair work, for example when 
the nozzle of a spray or welding gun held by a robot needs to be 
cleaned or replaced. When the maintenance or repair work has 
5 been carried out the robot that was moved independently must 
then be brought back into exactly the same position and it must 
regain exactly the same status as it had prior to being moved 
independently, i.e. it must be returned to the same path level, so 
that it can continue to work synchronously with the other robots. 

10 

If movement instructions are provided by a single general 
control program, moving one robot independently of the other 
robots becomes impossible. Such a single general control 
program also has to be rewritten every time the work, or the 
15 mechanical units of a system are changed, for example when a 
robot is added to the system. 

A known solution to this problem is to have a separate control 
program for controlling each mechanical unit, and to connect 

20 each mechanical unit to a separate control system comprising a 
path planner, which plans the movement of the connected 
mechanical unit. In order to carry out synchronization of the 
mechanical units, the separate control programs are executed at 
the same time. The control systems are connected for 

25 communication with each other. For the purpose of 
synchronizing the movements, one of the mechanical units is 
selected as a master and the other mechanical units are 
selected as slaves. The path planner of the master unit 
interpolates the movements and then transmits position data 

30 and interpolation data to the slaves. The path planner of the 
slave units interpolates the movements of the connected 
mechanical unit based on data received from the master unit. To 
be able to switch between synchronized and independent 
movements of the mechanical units, the control programs of the 

35 cooperating mechanical units contain specific synchronization 
instructions, which are translated by an interpreter program 
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translating the control program into specific machine 
instructions, and there are then specific method sequences for 
synchronizing the corresponding mechanical units. A system 
using a master slave concept is for example disclosed in 
European patent application no. EP 1 090 722. 

The master-slave concept shows a plurality of disadvantages. 
One disadvantage is that the accuracy of the synchronization is 
significantly reduced due to delays in the transmission of data 
from the master to the slaves, and due to the fact that each 
movement is planned separately without considering possible 
limitations of the other mechanical units. To maintain a high 
accuracy of the synchronization in a master-slave concept, the 
speed of the synchronized mechanical units must be reduced. 
However, in many applications high speed is demanded. 

The mechanical units are usually programmed to execute a 
plurality of tasks. Certain tasks require two or more of the 
mechanical units to move synchronously whereby the movement 
instructions in separate mechanical-unit-programs are executed 
at the same time in order to coordinate the movements of the 
mechanical units. During a coordinated task, when one of the 
mechanical units, or part of a mechanical unit, such as a 
manipulator arm, is displaced or rotated, this displaces or 
rotates the coordinate system in which the other mechanical 
units work. It is important to know exactly how the coordinate 
system has been displaced or rotated so that other mechanical 
units can be directed to the programmed positions. 



SUMMARY OF THE INVENTION 

The object of the present invention is to provide an improved 
control system for a plurality of mechanical units, which enables 
the mechanical units to be operated individually as well as in 
synchronous cooperation.; ••' 
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This object is achieved by means of the initially defined control 
system, characterized in that the control system comprises: a 
program means comprising a plurality of mechanical unit 
5 programs, each comprising program instructions including 
movement instructions for at least one of said mechanical units, 
a plurality of path planners, each path planner adapted to 
receive instructions from at least one of said mechanical unit 
programs and on basis thereof determine how the mechanical 

10 unit should move in order to be able to execute the movement 
instruction, wherein at least one of said path planners is 
adapted to receive instructions from at least two of said 
mechanical unit programs and on basis thereof determine how 
the mechanical units should move in order to synchronize their 

15 movements, and switching means adapted to switch a 
mechanical unit program from one path planner to another, 
whereby the movements of the mechanical units are 
synchronized when their mechanical unit programs are 
connected to the same path planner and the movements of the 

20 mechanical units are independent when their mechanical unit 
programs are connected to different path planners. 

A mechanical-unit-program is a control program including 
instructions for controlling one or more mechanical units. The 

25 control system is adapted for storing a plurality of mechanical- 
unit-programs and for executing the programs in parallel. For 
the control system to be able to handle this, it comprises a 
plurality of path planners, which create motor references from 
programmed positions. The movements of a plurality of 

30 mechanical units are synchronised when their mechanical-unit- 
programs are connected to the same path planner and are 
independent when connected to different path planners. 

The control system comprises means to switch at least one 
35 mechanical-unit-program from one path planner to another. By 
switching a mechanical-unit-program from a first path planner to 
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a second path planner the mechanical unit is able to switch 
between Independent movement and synchronised movement. 
The movements of two or more mechanical units are operated in 
synchronous cooperation by connecting their mechanical-unit- 
5 programs to the same path planner, and the mechanical units 
are operated individually by connecting them to different path 
planners. Due to the fact that the synchronization status is local 
to each of the involved path levels, the mechanical unit takes up 
the same position and status as when its program was switched 
10 from the first path planner to the second path planner. 

Thanks to the fact that the mechanical-unit programs to be 
synchronized are connected to the same path planner, the path 
planner is able to perform a parallel interpolation of the 

15 movements of the mechanical units to be synchronized and thus 
the aforementioned delays of the master-slave concept are 
avoided. Another advantage gained with connecting the 
mechanical-unit programs to be synchronized to the same path 
planner, is that it makes it possible for the path planner to 

20 consider limitations, such as current, torque, and motor speed, 
for all axis of the mechanical units to be synchronized. Thus, the 
accuracy of the synchronization is increased and accordingly it 
is possible to increase the speed of the synchronized 
movement. 

25 

The expression "movement of a mechanical unit" is intended to 
mean not only displacement of whole or part of a mechanical 
unit but also includes changing the orientation of whole or part 
of a mechanical unit. 

30 

According to a preferred embodiment of the invention each 
mechanical unit program is connected to one of said path 
planners, and said switching means is adapted to upon 
command disconnect the mechanical unit program from the 
35 connected path planner and to connect the mechanical unit 
program to another path planner. As long as there is no 
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synchronization command, each mechanical-unit-program is 
connected to a different path planner, which means that the 
mechanical units are operated individually. Upon detecting one 
or more synchronization commands, and based on available 
5 synchronization information, the switching means disconnects 
the mechanical unit program/programs from the connected path 
planner/planners and connects the mechanical unit 
program/programs to another path planner. The synchronization 
commands are for example provided in the mechanical-unit 
10 program. Each mechanical-unit-program is connected to one of 
the path planners at a time, i.e. each mechanical-unit program is 
connected to only one path planner at any given time. 

According to an embodiment of the invention the control system 
15 comprises a central data storage means and at least one 
mechanical unit is arranged to transmit data concerning its 
position, such as robot arm position, its joint angles or the 
orientation of a tool mounted on the robot, and/or status, i.e. 
operating state, to the central data storage means. The position 
20 data is given either as an absolute position with reference to a 
world coordinate system for example, or a relative position with 
respect to the mechanical unit's previous position. This 
embodiment enables easy access to information concerning the 
mechanical units in the system so that the other mechanical 
25 units in the system knows exactly what the other mechanical 
units are doing. 

This means that the information concerning the position and 
status of at least one, or all of the mechanical units or parts 

30 thereof, is easily accessible and that it is possible to see which 
program and/or which part of a program a mechanical unit is 
executing. The control system therefore provides updated 
information on the position and status at least one or ail of the 
mechanical units on request from a mechanical-unit-program, a 

35 path planner or an operator who is monitoring the system or who 
is programming one of the system's mechanical units. A 
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mechanical-unit-program does not therefore have to be modified 
when one of the mechanical units moves. Such a system 
enables a robot to find an object located on a stationary 
manipulator, for example, even if the manipulator's location has 
changed since the robot's program was written. Furthermore, 
the position and status data for every mechanical unit is 
accessible by every other mechanical unit in the system so each 
mechanical unit can find out exactly what the other mechantcal 
units are doing even if all of the mechanical units are running 
independently. 

According to a preferred embodiment of the invention said at 
least one mechanical unit is arranged to transmit position and/or 
status data to the central data storage means when it is 
stationary i.e. when it has stopped moving and/or while it is 
moving to a new location. According to another preferred 
embodiment of the invention said position data comprises 
information concerning the displacement and/or rotation of said 
at least one mechanical unit's coordinate system. 

According to a further preferred embodiment of the invention the 
central data storage means is arranged so that data stored 
therein is accessible by an operator, a mechanical-unit program 
or the path planning means. According to a yet further preferred 
embodiment of the invention the central data storage means is 
arranged so that data stored therein is accessible locally and/or 
remotely via a network such as the Internet. 

The present invention also concerns the method for controlling a 
plurality of mechanical units, as defined in claim 9. 

The method comprises connecting a plurality of mechanical-unit- 
programs to the same path planner in order to synchronise the 
movements of the plurality of mechanical units and connecting a 
plurality of mechanical-unit-programs to different path planners 
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if the corresponding mechanical units are to move independently 
of one another. 

According to a preferred embodiment of the invention the 
5 method comprises connecting each mechanical unit program to 
one of said path planners, and upon command disconnecting at 
least one of the mechanical unit programs from the connected 
path planner and to connect the mechanical unit program to 
another path planner. 

10 

According to a preferred embodiment of the invention the 
method comprises comprising storing position and/or status data 
from at least one of the plurality of mechanical units in a central 
data storage means. 

15 

The present invention also concerns a computer program 
containing computer program code means for making a 
computer or processor execute the steps of a method according 
to any ol the preferred embodiments of the invention and such a 
20 computer program stored by means of a computer-readable 
medium. 

The control system, method and computer program according to 
the present invention is intended for use in any system 

25 comprising a plurality of mechanical units, namely robots and/or 
external axes, which are programmed to execute at least one 
task where at least two of said mechanical units move 
synchronously. The present invention is equally applicable to 
systems comprising mechanical units that are mounted on 

30 stationary bases as it is to systems comprising mechanical units 
that are mounted on mobile bases. 

Further advantages as well as advantageous features of the in- 
vention appear from the following description and the other de- 
35 pendent claims. 
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BRIEF DESCRIPTION OF THE DRAWINGS 

Fig. 1 shows a schematic diagram of a two-robot system to 
which the present invention is applicable, and 

Fig. 2 shows a block diagram of a control system according 
to a preferred embodiment of the invention. 

The following description and drawings are not intended to limit 
the present invention to the embodiment disclosed. The 
embodiment disclosed merely exemplifies the principles of the 
present invention. 

DETAILED DESCRIPTION OF A PREFERRED EMBODIMENT 
OF THE INVENTION 

Figure 1 shows a two-robot system comprising two robots 1, 3 
and an external axis 2, such as a workstation that conveys and 
positions workpieces mounted thereon. The external axis 2 
rotates about an axis, a. Robot 1 is a welding robot mounted on 
a mobile base. Mounting a robot on a mobile base extends the 
reach of the robot arm and increases the size of the robot 
workspace. The additional degrees of freedom in the mobility of 
the mechanical unit are however not a problem if a control 
system according to the present invention is used to control the 
mobile mechanical unit. The additional degrees of freedom are 
In fact turned to advantage by using them to accomplish 
additional tasks specified by an operator. 

Robot 3 is mounted on a stationary base and comprises a tool, 
such as a welding gun, mounted on the robot to execute 
specified work on workpieces mounted on the rotatable external 
axis 2. The workpieces on the external axis 2 are moved during 
the welding and their location is expressed in the robot 
programs using the coordinate system 4 of the external axis 2. 
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As the external axis 2 rotates, its coordinate system 4 rotates 
correspondingly. 

The system comprises sensor means on axis, a, to measure the 
5 rotation of the external axis 2 and means to transmit this 
information to a central data storage means in the control 
system of the two-robot system. The coordinates given in the 
robot's programs are therefore updated when the robot's path 
planners require such Information by reference to the central 
10 data storage means. Robots 1,3 are therefore able to move to 
the programmed positions and execute each programmed task 
accurately as the tools held by the robots wilt have the right 
orientation and they will be guided to the right place on the 
workpiece to be welded. 

15 

Figure 2 shows a control system 5 installed on a computer. The 
control system 5 controls a three-mechanical-unit system, such 
as the system shown In figure 1, comprising two robots 1,3 and 
an external axis 2. The control system 5 comprises a program 

20 storage 21 for storage of a plurality of mechanical unit programs 
(6,7,8), each comprising program instructions including 
movement instructions for one of the mechanical units (1,2,3). 
The control system 5 further comprises a plurality of program 
executers (not shown) adapted to run said mechanical unit 

25 programs in parallel, and to provide instructions, based on said 
movement instructions, and a plurality of path planners (9,10,11) 
adapted to receive said instructions from the program executers 
and on basis thereof determine how the mechanical unit should 
move in order to be able to execute the movement instructions. 

30 In this embodiment all of the path planners are adapted to 
receive instructions from a plurality of program executers and on 
basis thereof determine how the mechanical units should move 
in order to synchronize their movements. Each of the path 
planners is adapted to perform a parallel interpolation of the 

35 movements of the mechanical units to be synchronized. 
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The control system comprises one program executer and one 
path planner for each mechanical unit to be controlled by the 
system. Each program executer is connected to one of the path 
planners, which means that the instructions from the program 
5 executer are sent to the connected path planner. The control 
system comprises switching means 22 adapted to upon 
command disconnect a program executer from a path planner 
and, and instead connect the program executer to another path 
planner. This means that the instructions from the program 

10 executer are redirected from the first path planner to the second 
path planner. The movements of the mechanical units are 
synchronized when instructions from the program executers are 
directed to the same path planner and the movements of the 
mechanical units are independent when the instructions from the 

15 program executers are directed to different path planners. 

Further, the control system comprises storage means 16 for 
storing information about which mechanical units to be 
synchronized and which path planner to be used for determining 

20 the synchronized movements. The switching means 22 is 
adapted to redirect the instructions based on said stored 
information. The switching means 22 is adapted to receive 
synchronization commands from the program executers, and 
upon receiving at least one synchronization command 

25 redirecting the instructions to another path planner. The 
program executer sends the synchronization command upon 
detecting a synchronization instruction in the program code of 
the mechanical unit program. 

30 The switching means 22 is adapted to, based on the information 
about which units to be synchronized, wait until synchronization 
commands have been received from all of the program 
executers which run robot programs for the mechanical units to 
be synchronized, and then redirect the instructions from the 

35 program executers, which run robot programs for the mechanical 
units to be synchronized, to the same path planner. The 
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switching means 22 is adapted to send information about 
completion of the redirection to the program executers, which 
run robot programs for the mechanical units to be synchronized, 
and the program executers are adapted to, upon receiving 
5 thereof, execute the next program instruction in the robot 
program. 

The control system 1 comprises three mechanical-unit programs 
6,7,8, containing instructions such as "STOP", "START" and 
10 "WAIT" and also movement instructions such as "MOVE TO" for 
each mechanical unit. The control system 1 also comprises a 
plurality of program planners 9,10,11 that tell at least one 
mechanical unit how to move in order to be able to execute a 
programmed task. 

15 

Each mechanical-unit-program 6,7,8 is connected to only one 
path planner 9,10,11, at any given time. Arrows 12,13,14 in 
figure 2 show that each mechanical-unit-program 6,7,8, is 
connected to a different path planner 9,10,11, so when the 

20 mechanical-unit-programs are run, each mechanical unit will 
move independently. The control system 1 comprises means to 
switch the mechanical units from independent to synchronised 
movement. If the mechanical-unit-programs 6 and 7 are to be 
synchronised, the control system disconnects mechanical-unit- 

25 program 7 from path planner 10 and connects program 7 to path 
planner 9. When mechanical-unit-programs 6 and 7 need to be 
synchronised, they are both connected to path planner 9 as 
indicated by arrows 12 and 15 in figure 2. 

30 In the two-robot system shown in figure 1 the welding robot 1 is 
programmed to execute at least one task where its movements 
are synchronized with the movements of the rotatable external 
axis 2. The welding robot, 1, may however need to be moved 
independently of the rotatable external axis 2, for maintenance 

35 work such as unblocking the nozzle of the welding gun held by 
the robot. The corresponding robot programs are therefore 
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interrupted and robot 1's program is connected to a different 
path planner to enable it to move independently of the rotatable 
external axis 2. 

5 Once the maintenance work has been completed robot 1 is 
moved back into position, its program is re-connected to the 
same path planner as external axis 2 and the programs of robot 
1 and the external axis 2 are re-started. 

10 The path planners 9,10,11, communicate with a central data 
storage means 16 that contains position and status data 
transmitted from each of the three mechanical units. The 
message exchanging, or communication, between the path 
planners and the central data storage means is indicated by 

15 double-headed arrows in figure 2. In this way the path planners 
9,10,11 receive updated information on whether, and how, the 
three mechanical units have moved as well as about the status 
of the mechanical units. If a mechanical unit has been displaced 
and/or rotated then the path planner calculates the position 

20 and/or orientation of that mechanical unit's coordinate system 
before providing movement instructions for a mechanical unit 
working in that coordinate system. 

Movement instructions are then transmitted to drive modules 
25 18,19,20 associated with each mechanical unit via a main 
computer interface 17 so that the corresponding mechanical 
units are able to move to the programmed positions and execute 
a programmed task. 

30 Although the embodiments disclosed describe a three- 
mechanical-unit-system, the control system according to the 
present invention can be used to control any number of 
mechanical units from a single controller. Addition of a 
mechanical unit to a particular system requires only the addition 

35 of a configuration file into the inventive control system. 
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The control system comprises the . hardware necessary for 
carrying out the invention, such as one or more processing 
units, input and output means and storage means. 

5 The invention is of course not in any way restricted to the 
embodiments thereof described above, but many possibilities to 
modifications thereof would be apparent to a man with ordinary 
skill in the art without departing from the basic idea of the 
invention as defined in the appended claims. 



